geometry_msgs/PoseStamped input_pose
geometry_msgs/Pose lleg_pose
geometry_msgs/Pose rleg_pose

